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©4) row©**] fcwajBiwifBWSB:*^ 



(57) [gift] 

[me] avifa-i'ieiisftfc** (cg (3> 

550 ^^flfe^cOifb^'f*: (ffl7) Kfil*d#GJ©*ifiak* 
?>K*L/;lijftC"l»L<«iWfiAKov»TOrtWJ: ») "b** 

&mw®i*nwL&m&-cihmw®mzm-r&¥wt 2^ 




• 0 



(2) 



fcBIV 1 0- 7 4 2 1 5 



1 

li^#rilft®©,'N-^<a*^39>t>&4 l {bftM 

*frOWjftOfit1t^^ h A\ U< lift— ^rOCilbftoP 
4 ® 1 ©ikiS*"* * h b „ 

metis i ©gag-** h/uatjt^a-c*:i&5>iife«i£te 

"C* «flB£iiftffiWft:o«ia»jft"CKi!!ittlB*# 

ra&H 2 ] mam 2 ©aaas^* h ;v^##st?* 
tbhtitzusmatzttmitm^ wwc*c?v>t, h&E2 

«Jfe#R 1 ism?)®* 

4, HTBflilBllWWIctfllJRi-AfliaiB^f 

fc» oMi AO*** & & 4 u#fit$8 t Ets-r 4 ^ttit 

#REft*fS:fc. 

j£-f 4 & ft ffi' « ? -? 1 * 4 ft ® >< v 

t b z&mb-j-hm^.m i E*«>»ffHe« 

IW** 4 ] US* 2 co£JS«^ * h 

(otias^^ h rim* l < imw& 

(Dm'&mUr b;V^*«)4- tHftt>»3, HtEI£2©ft 



* j§mk« *s »= *^ t ffl is £ *t tz amm B^-r 4 am 

£ #tT * 4 2 o © 2 *7CiS«fls©*i£«jftH 

»^offljiSott«^^ b>W tL< ttt*— #©fl*MM« 
;<yf S-Sfig-t- 4 7t K) coftlj^l.irwlig^^ h ;v £ ©rt« 

-1i(n&®W<DmftW:&frhmfitzT%&i> L < ttlW»£ 

BtrlB* 1 ©SfiS^ ^ h )i<$in^mx~j£)6 h ixtz&&& 

\z&-t&fc1BlLbfe&1-2>mz1l:&&m'<* Y)\y\zmsL-f 
4^2©*)S^^ h 4: fc**MR 

7 ] «rfB» 2 ©tfig^ ? b ;u«*#S-c-# 
fex-&zWi&izisrtzma&ftte<o-m&<DM<kz^i- 

4, frfBfift^#Sr»^i-4fiftlt/f-yf-SrS)S-r4 
Zi*oWIBl*<7)*'&*^44^1f#«r|S1g1-4^1t 

mmm^mb. 

M«*?**i-4i4:lcJ: t)fr^:>5r®«««4-**4^bt 

40 mnmm^t. 

tb&ammtoitn&fttontzm^xmam&yBftim 

im*m 9 ] iEt 2 o^iss^ * h ^st»#a**. 

(D&ftm^? Y >v*?fzit>2>z\bizttt>t). fEf 2«f 

y ^mn.^mzis^x<$-®<o®wji> l< i±^m 



(3) 



1 0-7 4 2 1 5 



3 

Ml 1] -^3J*£b#-ffl^T*4-i:**^S$tL 
«U< (±3R.*7S*i£IiftM<D^f y *■ t> 4 affi 

a»flfrflijat$*Lrfti2oo3*7ci!!i»#o*a»jft » 

;wraboT, ft 2 o<oa&#<o-9 

ofi%#*«*-r4, ft-;froa»to6*a#-E<re<Jb4 
*&-^<ois^(Ofi:e^^ F ;k L < lift-^oafete* 1 

& IS 1 OtiSS^ * F t „ 

ttEft 1 f e>*tfc*is« 

F;w*r, ttEaiftlB*»OtfcjE«j&rttaifel6*tt 
K«i-4WfcittXi-4tffc4*i£*^* F^KftjE* 

48 2 o«ja«^^ f **-r 4**h£«i 

»£:/n^?A:W&jtftSftT44££*#«fc1-4&# 30 

mmmmn fa 7 9 a ten 

[MM12] ItEttttmElEift ft yn^7A^ tft 

b* 2 * h*at»*R-e**6&*Lfctw«aif*: 

* tz F* l x v> 4 * miti- 4 T®mfe^8L * #1" * 
*OT*4£fc*1MRi:"r4IIMt*l lEtt<0&#Wffi 
JiStftyn^AEttlH*. 

»t*«a*ft»onijfto*-ft-tfli*i-*, tjfBaft®^ 40 
# * *jr-t * a M m / < y * s fc * <Dum & e>m 

*EaiiiiH«#oji5«flwiK*^v»r»aiaiB«flt*« 
jSi-*aamH/<yf-*±*i-*imH-'<yf-flMii^j«#R 

i**r1-4*>wrfc4£2:*#&ii-4fi;fc«l 1E« 

attttHEftgift fay? a Ett«#o 

1 4 ] ttEft 2 OSiSS^ 9 F JWRimt so 



4 

S1WS2S^^ h**ft*«tU»v>TlHttfcL<ttje 

<osfis^^ F;na»^atcijv»r4-@<o«i&t u<« 

fcJKS*"** fJ'KfltiET* fce-cfeftc 

»©#t*sj£ ?ntfts2o©2 ^k5c'a«flt«)*js»ja 

tMB2ooa*#<0*iSSF^Cifa L**§.««iS«^ F 
mot, ft2OWdht/-^<0d *><0— *©i!bft#*»f) 

m*<oa^^{fi]^ ; 7*t6]^«ia«^ : }' F;wfc. ft-* 
Od»#tlMtt4, ft~*oa*M*:* , a#A»-c** 

a toumtex- $> 4 ©ft a tomote* 4 a urn 

<o-5*>> ft— *wat»#:o> ftflt*oa*#^*ti-4« 

«rte* 1 w*ja«^^ f ***#«-e*»fe*tfc«ifi* 
F;i/*, «riaaffl«i»#o*i5«jft-cftasi«i«&^ 

»cSi-4iti»tE5!l-4«r/c4«ifiS^^ F;Hw«E3E-T 
4»2<0^a«^^ FJV*^#Si:«:*i-4!ft#IBffifSt 
« ft 7 a ^ 9 A jP&M * tL T tt 4 i i: # ft 1 1" 4 % flc 
KffifffiSft T-d^A f2««Eff 0 
[ft*« 1 6 ] «TIB!fefltMK«»» -T a if 7 A -hK m 
UMS 2 (OWc&m*? F ***¥«T**> e»*tfc«HB*frt: 

o tr 9 a i e««E# 0 
7] «fgE!i&#raKttt<t«;rn^9A**, «r 

#:Sr«l£i- 4 afi«l^< » f - *«fi£i" 4 fc»0»J8P.4tO« 

WEaim«iw#ojg«*«c*^v»Tftaft«i»fls*fli 

tS-*i-4t(0-r$>4::t«-iRFfti:i- 48f*«l 5E® 



(4) 



&m¥- 1 0-7 4 2 1 5 



im*m. 1 8 ] tnum 2 <owci&m^ 9 \- ^mm^s. 

fro 

10 0 0 1] 

KM! #f&93li> 3vea-^±K 
*3£ S fitzfyW (CG Ovfi-^^-f ?^) 

ftfrMffiHtiSlfyD 30 5 *&*ft $ *fC 4 atrffcH &ME 
»#yo^5A |B« jKfr K H 1- * o 
[0 0 0 2] 

MIC *a4^70?^WS (7-^f->3 
>) /PC Vkfj.-*) Srttofcy- 

r — > - v a > , ? *-?^;i--wsaiii-> 

G •f';v* f SvncjittT v» -a frb & v> ii£v»»cTa» L X 

x-o&mmito&ztimitix^zK, 

[0 0 0 3] Z<vmmi~fo^Ztz#>K$£&?Tt>iT-X^fz 

(a) atKJ:****4*ofc#8to W#*38W>*-S-C« 

T*R»*«3fe"r*. *S#frt&4, 5 7 8, 7 5 7f 
M(Stark) , *B4*tt*4, 9 2 2, 4 3 Ot 
M(Wavish) , Km&VtmS, 0 5 6, 2 3 1 
^■£m (Nakano et a 1 . ) , #H¥ 6-8 
3 4 2 2 # mW- 2-224004 #83 

¥6- 2 5 9 5 0 6 7- 1 0 0 7 3 3f 
&#R^ K H * $ nfc^fe^i JUTS tz * e 
[0 0 0 4] (b) ^WSriW*»v»9X'f ^<0*-&H^-#J 

^V'^Oi" * tic «t »k 

fl^o #B#friS5, 1 5 0, 4 5 2-*&# (Poll 
a c k) , *B4*ffFJ*5, 3 4 7, 4 5 9^» (G r 
eenspan etal.) CH* £ tltzJj&IPZ. tl 
+ *S#^5, 3 4 7, 4 5 

#tc»±, ^^ffiffiic^T^^^*^, ±E (a) <nn& 



[0 0 0 5] (c) T#Ltv^f«i:ftiH^Ofa 
<r>-?y?i, y ? ?,(Ofrmx-&<%\h*itz "nv 

7^ ¥a. U- v a > • (Conf i gurat 

ion Space) " ±i:fiL, 
PSrtTfl&7;2nS;o #B#fr&5, 0 4 7, 9 1 6-f-<£ 
f (Kondo) lcpg^$tL7t^-6<i*tlCffl^1--&„ 

10 [0006] (d) TE. G. Gilbert, 

D. W. Johnson, andS. S. Kee 
rthi, IEEE Journal of Rob 
otics and Automation, Vo 
1. 4, No. 2, pp. 1 9 3-2 0 3, 1 9 8 
8J Kli, #gl£il#tS#Kl&;eU fl^Mfri^ 

jft ra co mm % * $ fix v»* „ 

[0007] 2o<DC I #ffifrosia«.^^ 

U^fe^ -?"*t<b 2OOfl#I#<0l *>©— Jj<O&0- 
[0 0 0 8] 

[f&fB^fS&LJ: 7 t-tzmm] ±ffi (a) ~ (c) <D 

<tv\dJ-c±te (d) O^fttcjfc^affltgHJi/tv^, 
<T>--fiX, ±ffl (a) ~ (c) O^&lt, ±15 (d) <D 

[0 0 0 9] 1-&fc>*>, ±Ifi (a) OSfc&SK J: <£.^ft 

ffifr^M^t-t-^^^. -tie (d) (D^mKtt^&fr 

<DW-a!l^r-§^^i:v^F^jgd s *)^ 0 * fc, ±f£ (b) 
?■■< XVUz&.WZ>tziit>. g-fcyy-J x&±<Dmg.<om& 

[0 0 10] ±ie (c) <D^&X*tt, =i>7 4 

±te (b) tmmz. m&tfWi < *§-g-unv ? 
LW.t&m#*> <o . mmtm \z*t lx »j t ;v ^ a k# 

50 It-t4ifc^-C^*vv ±5E<0*H#ir^5, 0 4 7, 



t 
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[0 0 1 1] £*i.<b (a) - (c) O^mzit^ ±IE 

(d) <o#£i±, ^gy&ir^asr^t-it.rsv^^iiiv^ 
T v »* HML ± o EMI £ r & a K * ttl f * - ** °T 

[0 0 12] ±K<HtSKfi*, tf&SrCilfi® 

[0 0 13] 

oo3*5ECi*lftO«ifi*jScllBE«l*. Wi2 -oOibVote 
( 1 - 1 ) ±122 o©i!b»flco«2*jStif ^ L 

&w®&*MWL-r & a » *■ *««-r & 01m 

».*t^t,*^lS^fc L < li«fM*K:ov»T©rt«J: ») 
( 1 - 2 ) JLE* 1 <D&i£g-c * f JUM»¥ftT<ft h 



1 0-7 4 2 1 5 

8 

[0014] 1 OttttHEJittftttftli, 

( i - 1 ) o» i otas^^ h ^a»^s»cijv>-c, 
(i-i) KBfcufcata* «*.tfimLfc (d) 

KKlE«**tfc#tt*fflv»T, ttft&-f£2oOi!!i4btt 

*><0-C$>£t&*, -ttilci^Sfc-f (1-2) ©f2©S 
h**»*«fci»vvt\ (1-2) CBJJLft 
ISSlc^v^r, ( 1 - 1 ) <om 1 cOftifiS^ * h 

(i-i) , (i-2) \z%&mLtz&&mi l z& 
-3<mm** m&Ltz (1) ~ (3) oastawKjt^ 

5^o*-c&< 2o<Do^rao«fis.^Mi£ait** 

[0 0 15] ffi, 3 om±<7>#&©fl«W:aq¥;£ U -5" 
Jt<?#&<0£j%#<TC 7 *> f CD 2 o©fiflMW«T» L-e 9 
*5*» iTO 2 ocoa^ffHcoSaS-^^ 

i^«co o *>iSS L /c«S:co«Sr $ <b tc 1 oco^^-TS 
7 tv^ J: ^ KLT2ii.CDfi&/f 6<M ^7')-SriSU 
*9V) -m±izm^mm (Depth-f i rs t 

a^W^T^rStraii-^tt (4fS¥7- 1 7 4 6 2 7 

[0 0 16] ±IB*%^(0« i cD^raggstsc 

( 1 - 3 ) ±f£» 2 OSSfi^* h P> 

[0 0 17] S^WtcT^UTV^^S^cO^J^** 

* 1 O^^KIESIia#Saii, JtB ( 1 - 1 ) . ( 1 - 
2) co##^tcSnx., 

(1-4) ±IB2o<DdIi%#c0 9*.'0-^5!i*ia#®'f* : f 

&zm&izisvz*<oag'&m<7)mgL<r>m&t&'S-r 

(1-5) ±ECi«flt«>*»»v»LJC»*»^i-*fll» 



(6) 



&mW- 1 0- 7 4 2 1 5 
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(1-6) J:Eflflm»flc©ig«W*fc*-^v»-c-e-©i!b 

[0 0 18] *«H«>4MtnEiBttft!feSii« 
Kttgsittt. ±eo d-4) ~ d-5) <o#^a 

v»Tv»4. i<D*^lc, ±E (1-D W«l©fi5S 
b jWj|f¥St-l±, #i§¥7 - 1 3 4 7 3 b^r<kn 

©eaft^ Ui£«ro^fr<o^jcab4 1 

[0 0 19] $>&W±. \s--um<r>{h®>te<0 

EttatjtiKit Visits, *<o* o izm&imtzmmte. 

±15 (1-2) co^oSfig^? h>M**#IW, ± 
Efl^te^iij f> l < i±se^$:ft.fc»'frfcx ±es& i ©. 

K*#^*L£$r7tftei£&^ hJUfr* (bKSrfcftSifi 
[0 0 2 0] JSigEL^I&fc L < «a*LfcJE»»c*v» 

£38^* V frZ$itz\ l z3iit>W.-rtti? t ) fc, 4-®©#i& , {> 

^jS^* h ;l/ i6 & £ 0 ££££ 

J; ») , #ii)ft v> LK&OfcPK* 1 coftj&g^ h )VC 

[0 0 2 1] £ <b ±E#S&$©£ 1 o^M^ESIfl 

( 1 - 7 ) JhE ( 1 - 4 ) OJ§M*flMWE*#KKe«S 
KtzWtnm.& i. tf±E ( l - 5 ) outfit f&Mfr^IS: 
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[0022] 3 ft«*¥t3:£fiix.*- ti-<t »K 

*^«<0d*.O^2<0%#HffiJSI«^fi«±. -*7&fl 
^ttfcttfit-f £<£>©•?£> .&o WTicSi^i-*^^<o 
£2 fc*H-*f1MI 

[0 0 2 3] #S&I||<0£ 2 ©&#HEtti*IM£Sl:^ - 

atoWKDs* y ^-(D&'gfr *b ft £ {hmmtofc-£%$L £ tfC 
*«2oo2^7Ci!S»#<0«i£»J»nElt*% -f-0 2 0 

(2-1) ±fE2o©A^#©*ia«,£f 9 LSr^ft 
i5^^<^ h;vr*c.-C, 2 oocyte©? %<T>— * 

vn&imf&i- & fliii^ f «riss;-r & tz*><r>mn& 

( 2 - 2 ) ±E» 1 Wftifi^^ h ^«lt¥ST** t> 

[0024] i£-c\ jtE*5iwo^ 2 m&mffi. 

( 2 - 3 ) ±E» 2 ©SiS^ ^ h ;Vt«»¥-ST**J6 <b 

flt if d U t T v» * *5*» t fl Jti" 4 T»«3e#« 

[0 0 2 5] 4 fc, _tE#*§B©£ 2 (Ot;#;P^KjlSiS» 
40 ^fiii, ±E ( 2 - l ) , ( 2 - 2 ) <r?#^St-inx> 
(2-4) 2ood^#©d *,<o— ^r**a#ft?^-e*4 

ffi&fete* -i. a ffi^ v «r «fis;-r tz ib <r>wm 

ft 4 ^fc«a«- E«1" S ?g«t»#E«#© 
(2-5) flt>#©fS»ftV>L^£tt^-f 
o'v^T. -fOdi^^OlS.^ft^ uatj^i^o^siift^ 

T&'&vmm - 1 c * o «fc ft^«i*««-** 

(2-6) £bttai»#0»ttflM»K*^»"C*«>CiO« 
50 %#S-«fi£-r'2>diffi^>'' ? ^^*4.fiS;'t ; 5>ffi^ < ^'^<*^ 



(7) 



ftffiW- 1 0-7 4 2 1 5 
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[0 0 2 6] £<D*&<&K, _tffi (2-2) <0^2<OSiS 

ZtitzW,&\z, mi (O&i&m^* ^;^SS¥S(:ii^>T 
[0 0 2 7] SfcK, ±IE*%^c0^2O^#raffii5i® 

(2-7) ±iE^«ffiisit#s^feti$n^^i«a 

[0 0 2 8] *fc±EBtt*il*-*-«#*W©*MMIie 

jsstgrn^Afesiitt?)? *><o^i tf>f&#r.8KSi?fc 

li h £bfflffi^/#f#^ $ JlT * * 2 o«9 3 <k7ta%0&<0 
*J£»£WE*t«:, SE2ocofl$>#<D, Efitt«tit$S£ 

(3-1) ±IB2o(0a®#^Sa«^if-9 L 
&W%0te*mi&-t * GUM/"? -7 *■ * fci&OMSl 

.so&g-*? ±12— -yi<r){bmte 

( 3 - 2 ) ±!5£ 1 otiSg^ * h t> 
raffifSt«» 7 n ^ 7 A H^lffi $ *iT * 4 £ b i # t -t 

So 

[0029] *&w<on i <o®)fcw&mm%.-7v if ? a 

A**, frffioljll ^#WffiSfiS[»£fli:|63taL (3- 
l) <ofi wSjag-s* Wi>jg[g#8(c;fcv>-c. (3- 

i) KcaLfcara. eoxtfiiir&L*: (d) ©xrke 

&m&t*.%Ltzt&<0&i8;1&'<? h bar- 
$>hi)K ZtUZtZtb-r (3-2) wtaotist^ 
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9 WHSir¥f3:Ki3v»-t\ (3-2) KE& LfcHigK 
£c^-C, (3 - 1 ) OS&l O&ifig^* hJMftjreft 
HiJV%T**P>ir^*iaS'<^ h^«-&IELTSr*:£S: 

(3-D , (3-2) izm&Lfz&mmizm^ < 

ttifcLfc (1) ~ (3) <Oft$fc&$f5KJt-i;g*!> 

io <a*-c*< 2oodi^#ra<osia«^raffisn()*i6ii 

[0 0 3 0] ft, 3 o&±<0#&<Odl%###£ U * 
*i t> A^ttw 9 *> t?<D 2 oOflftW^ L -5- n 
i-^t>*,f<0 2o(Oi!l^#M<OSa^^ 

d *,ia« Lfzm®.<om $ <b i ow-a^-cs 

20 ^ ^ y >; -\fi±\,Zffi&%i&m (Depth-first 

mm) zm-rztizx *)m&Li:^z>°i&&<7>WLi>&^ 
a^n^rimxfm-t^m mmw-7-i 7 4 6 2 7 

[oo3i] _tfE#&9i<D» 1 wfe^KESi?* 

HEJSa^^n^^A^ 
( 3 - 3 ) -hffiffl 2 OSJ5«^^ h ^?1[#*gi-C^ft h 

titz±mmz%m&m'<? h^cat^r, ±ie2o<o 

[0 0 3 2] m^Mlc^^LTV^^S^cO^J^** 

M ^ *tfc«#WIE«*» ^ o 4T 7 A ±fB ( 3 - 
1) , (3-2) WS-^SKiOx. 
(3-4) ±ia2ooG^<0 9*>W-^7!i t db#-M^-C 

hh^%\z&kj%*<n{h&ttb<r>~fa&<r>%%-k'&S-$ 

40 &m%^L&Mimm-rzffiWLiz&-3\,*x*<z>a%a#.<D 

Z t izx 0Sr/ci^K«*^MSr-rs^1f«Mff*e 
(3-5) ±f5i!lffl®^O^««ffitc»cf^T-E-<0ifi 

[0 0 3 3] *%^<0^#HIEfiia»7'n^7Affi««E 

mz&mztitzyd&ffi&mmm7nr7J*i3: &.&tit 

ffiJBS#^D^7A»i, ±120 (3-4) - (3-5) 



(8) 



1 0-7 4 2 1 5 
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[0 0 3 4] ±fifi (3-1) <D^l<0*fi 

ffl¥7-l 3 4 7 3 5^ 

jfltifitt <0 v> L &flJ® A «0 * fc o v> T |*J 

[0 0 3 5] ■MH"4 7l'-AWK>iMM*© 

& t n US l h ;v«^^-e<D*J£«^ 

±fe (3-2) OgBOAiSftt? F^S»¥S*^ ± 
[0 0 3 6] a**L7tf£i&t> L< liiEttLfcJHBKiJV* 

-c***^ s&i ©fus*^* 

J: >K ^0©#»)&f> U< \im.m%.V>{hWm~^X<D 
<t •) „ =£l&fcv» L^Ofcl/tw» 1 OfciSft^* h JVC 

[0 0 3 7] JifBBM£*firf **f&l8<OfH£Pfl 

t -r 4»fls«e**»^n ^ 9 a s ftfc 
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[oo3 8] *ftw<nm2v>mw$9m&n-7*y*7^ 

(4-1) ±IB2owdb!gj#co«:ja«^f d LSrfe^* 

at^t^ hJK-*or, ■t<o2-?cr>thVdfo<n ; ) *>©— 

%0-H<D £j® filter* * -5. »<fr© -5" © £b ffi& 

£ {hmtikW'* v f - S:»JSi- * 

IWfr©fii»flsfcW-*- 4*iSSW*fciSv»fl[ji*fc L< I4*W 

( 4 - 2 ) _tE* 1 ^ h ;va«#s^*» 

\z®ttz>%.2<o&&Mi'<-9 

HffiSI«» 7* n 9 A tf*t&ifft ? *tT * £ C t Sr #@ t "t 
[0 0 3 9] iIT% ±IE^WO^ 2 0^#H!g!5t« 

30 ( 4 - 3 ) ±E« 2 OftifiS^ ^ h *atfgt** e> 

[0 0 4 0] * fc, ±IB*5IW^>^ 2 Ot)#HKf8l»» 
»^n/7A^ ±|B (4-1) , (4-2) <D&^WL 
(4-4) 2OC0db^#^»d ** ? fl#^^-C*>* 

^o^fflj* L&T&&<nmmzmn-t * - t ^ 9 Sr£ 
(4-5) am«i!fe#o^Kfl!«K*^v>T-e-o£bffliS 

± l&^WL * G f * *> * o r J: V > „ 
[0 0 4 1] i Oil&'&tC. ±U ( 4 - 2 ) <D» 2 Oftjfi 



(9) 
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sat l< \t^f&mz.^hixfzmz^fk : &^^ v** 

[0 0 4 2] 

SiW-rSo El (4, ^W<0®#HIEStt»#^tt^-ll 

4o 

[0 0 4 3] 121 y^ji 10 0 

14, CPU^MO OfcGB$t7V X*) r&fi^a* 
rtj&$ftfc##8Bl 0 1, *#8&1 0 l*fc Office J: 
9 , S^IS® 10 2a ±(C®«Sr^-t-&iffl^^gC 1 

0 2, ;©3Vea-?^f Al 0 0 K«*<Df|$S$T 
A*i"&Jtl6(0^-#- K10 3« BHfeft^ffil 02© 
aflll 0 2 a±<rcffigOft«*li5e1-*-7 , >* l 0 

4. *§tw<n®#.wmm.mn7u77&<D-mm : }&mi 

t&iWLTis<IBttg61 0 5**^x.t,ixrv^ 0 
[0 0 4 4] EtSSU 0 5 KteiM$ft*%#HggSI?£jr 

X?) 1 1 0'Kftjtt$*LT4J*K -fOMO 1 1 0«rCl<O 

miu^-rn >ea-?^fA i o ocsiit, £ 

(03vea-?yXfAl 0 0 i:7"> 7"n- K$*l£ 0 

A 1 0 OKte^SitT^ttHSglt^n^A*, MOl 

1 OK*'? vo - KL, -E-OMO 1 1 0 Sr^LTffe<Dn 

[0 0 4 5] laTTtt, *ttNMft**1la%lfeJgS 

o*Mi»i-e*^ f©7*n^ 7 A^ Ett**tfctt» 
OEHSB 10 5^ *5&W<0»#IWffilKiaSL7 r n 7*7 A 

ie««fro-*M0Bi!i*=*a-r*. -torn* 1 ? 
a**moi i o i~&m$tir^z> t §li, foyn/? 

ASrftiWLfc^JllcfeSMO 1104, *jino*#n 
[0 0 4 6] 12 2 14, *^W<Oia^HffiJSI«#SS<0- 

i±2 laiJai^of'-^osah., «»<o^6n»±, id® £2 

^1-^l^raKSI«#^S 1 0 U14, J&K1*4MBireR 1 
l**«x.f>ttTv>* 0 1 K14, £JS 



16 

,«HI£S»aJwWtt4 4 2 ooiMMIc© ^ *>o^* < 
ifc loodb»*tt«llijS»:J:-3T«s6**«.*iafliB/< 
?*-©*£-*&1IMtS*t*. 3&«««K«#S1 IK 14 
Ol»Ii'<?*-**«>TB1!LT*vvC* J: <, Mft&O 

[0 0 4 7] J&ttltffiEtg^iS: 1 1 Kf5te3*lTV>fcJ& 

di^OJ^RtilW* 1 ** <b ft 4 o 
20 [0 0 4 8] Jg«««E«#S 1 1 * R*ttl £ 

-cjouwuh $ *tfc»«fli«u4, ibih/< y 

14, JgWf «E«^I£ 1 l*»e.«*JB3*tfc»«flW»ft 
v» L»«« SIEff^S-CMSf S*fcIM*flMIW , iaiaiiW 
flso«Wjfto**r*4»-ft-K» 

*j£Sft4„ fc«L, Mtaies^si 

4>4*«\ J&KflME1MBl l*&3l*ai$*Lrt:iOHI 
LTOfijfflEWfcKoviTttfiifflH;*",' f«4« 
li^FR-C**. fllH/< 1 3 

T»4, 3^tt1t«5l«f#Sl 2-CJ6«r$*i-3t^Oiafl®!ft 

[0 0 4 9] mw< y 1 3 l^a 

ft, Iffgl 4KI4, *DJttRA«>8M* (Eg&«£-g- 
tr) Odbfete, fcJ:^^^, JKfc*M*v«l,JEX8 

1 3 tea Lfcjg«fliaiod 
*?i-^Kflift(4. 1 osjss^^ h ^mx^st 1 5 K 

v»LJHBLfc«©tt»«r**>-r»ttflWH4» * 1 
ms<? YM%n^WLl 5 1C4 4«IH4^5|-C*ifc*!), 
E«U, lf!2(Dfc£«^? F^iSifSl 61cA*$it 
4o 

[0 0 5 0] mi O&jfig"** h 1 5 T14, 

50 ft,6 2ow£b*M«sro*ifi»J*4r^ L*tt*«ifi«^* h 
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(ffi^) icifi]*^^|6](Oftifi^^ S3- (-7J 

[0 0 5 1] iOSlOSJS^^ 5-C 

feSo ^ © i ? ta t s i rotias^ n ^st #s i 

2coftffl«^^ F^ffgl SKXDZtiZo 

&&&x*<D{hmm%omzm-?z>w-wt 2 o«»#© 

[0 0 5 2] SI 2 <OW^m^-^ h M$i%^WL 1 6 T*ft 

ti, -toga*'** F;KOgS»Me (flOxtfl 0 
-io ) X*) t^v>^tc^*i: Ltv>4 2 ooflft^ 
TSMKHt-fc'K *) *>ftv**£-fc**it>2o4>,a 

[0 0 5 3] _L&L£J: 7 K, SlCtfiS^i' MU« 

?t^2 7 W>-Amf$<D^#c1««»±> 0 1 ©^iSS^* h 
^SffSl 5»±^-f/<x$rv>l_3f»>) LT, 

&2<Dm&m'<? y^wlw^i eizxuznz* w.2 

[0 0 5 4] &±<D£t\zLX, Um^WLl 4K«i, J* 
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T, ttfli: LTV>4 2o<7),!i%#:^3^7C©#-C*)-5i 

[0055] m 3 ^sswofettWEiistirse* 3 

10 ^MEttlRffttC 2 0 Ki3V>T, C P U 2 3 X\i, &tf 
[0 0 5 6] IStS^«2 7KI±, flsJiati**tttt©JSM* 

20 StlTV>* e 

[0 0 5 7] RAM2 6KJ±. C P U 2 3 K J: *) IBHIS 
«2 7^e>K*aiStL^*^^gl5*tW^T'-^=S- 
*&^i-^^7'-^^- ; e , J 2 6 as (flilfv^^^f 

- 9 C^TCP U 2 3 F*3K-CgtiJ X^tzMWIkT*- 
?ifeto-f2>m.&M&r-fjt*V 2 6 b, ^-r-^ 
«'J26a Cfett S ttfe^f - ^ iJ J: ^ffi^^-r* 
-^p<*'J26b K»«S*H./;«*JE»f'- ^ Sr^ffl L 

TCPU2 3rt-c»m$tt^>, f^mss^isi^sp^t^ft 
30 v ^ ^- ? % fe&i t t a < ffiffi^ r~ 9 * -=e 

2 6 c, ftiftg^ h;v*»ffi1-***T;V'^ , JXAj3 
iOffflM/^ y^-r-^^^'J 2 6c K*&itt$*LJtffi®''« 
vTT-?i&m LTCPU23 rtr^m ^ttjtgfi^ 

h)vr-f («ja«.^ «#nett. 

2 6 d, ^-f-^^-t'J 2 6a Cftft?n/:i«f- 
^ > ffi^fgmf'- * > * 'j 2 6 b K.Km ? *ifc«IWEt)l 
f-^SrffflLTCPU2 3rtT-gffi£*l*u ^»^<D 

40 ftf-^t^Ge^tUIitV'So 

[0 0 5 8] f-^A7jHf 2 1 »±, f^*»^SB*tO 
fi;®7 : '-^ J ^^l6T'-^*-<>^-7i-^.2 2ifrL 
tCPU23i:I4 0 ^77-(7^f^yi"f25 

-< 2 4 *^LTS|t><XT§^:, RA 

M2 6rt<7)ftfi«^^ 2 6 dKt&iftS 

2 6 b J nt ^fcftlERf - ^ - ? 

so [0 0 5 9] BUC, Jtftt-T* 2o(Ofl»ft4 f 3*7C 
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&®&X&-oX*tib 2 -ooaVd&IBUi&ihtomVdteT 
(*-*l) . tt&t-t* 2o^^*«3^7C 

am&x&ox-ttib 2 -oodi^^o-? *><o— ^dlffi 
WW*. ^^db^B^T**^ (<5--*2) , 

oaw^R^i'iaflHiiwflsTr**** (4r- *3) atf 

2oOdb«fltO?%0-**«llliai*flt, «i***i!i#ftJg 

Tn,zf>) xa (cov>rgi^i-* 0 
10 0 6 0] {'r-X 1 : 3^7Cdh^. Ji»o8Ufr3&*fli 
iiM^i^) 0 4M\ 03OCPU2 3rHff?^ 
*&SOii£*lfc7FLJtiStt0-?$>* o 5fc-f*-r?7'3_ 
1K«V»T, EI 3 OCiXt 2 7 £ ») , ffi*j-*ftSSRft 

0 3<DX7 7-f ? 4 XT' V ■< 2 5JtU, gB#-*> 

y^f-f xyi-f 2 5±ic^$*x^eB*t^> ft* 

tf^^TvyLSffm-To ^77 X3_3T»;J\ -v^-X 

»f'-5'Sr0 3OCPU 2 3tCA*"t* 0 *7-?X3_ 
4-CI4> *7-? X3_3^A#£*Lfc^K)f'-:S'K:gcf 

v>Tft)K-r*o *x 7 X3_6TUU XfV7'3_5<D 

&j£-f*o ^f? X3_7Tli, ^.-r-;' 73 _6 cDifeS 
*J«tU f *T;'X3_4 ©Jg«tSE»-y- * O^tC^cf < 
Mfci, 0 3 <T>m <( ^f^^U-f 2 5K^rt 
*T >-/3_8TJ±, *T VfZ_lX-m-ti\ZMz. 

_9\Z&^X : f&#4 > hiWiTFl-Zo Xt?73_1 
0-C»4, Xf '^3_3^f)^t7y3_8i5J:Wf 
vX3_9*T<0&g£i£lT^*;6*5*£fl»rU Wti 
tii^i:i^f^3_3 t:IoT*7 

[0 0 6 1] 05»i, 0 4<75*x;'X3_6OS:fig^ 
? h^gffiTJV^VXAOSmafrLfcjfc^rfc 
4o 06»i, 05<Ort, ^f7-/4_l~4_9«07D 

h^*#¥R<o-5ttsjgaio»MiaT?*4. ttz, mi 
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li» @5C0^f-;7 , 4_l 0~4_1 2 <0 7 n - fcfJflTF 

10 0 6 2] 3fc1\ S5Wf 77"4_1 TJi, ~o<0 
©•'frfrtttf, vok-fZ (0 6 (a) 

h fr<r>¥-%)ZW.Z>o 7 X4_2 (CiJV» 

ttfi^* h;V/«- po t^-^o vo i06«D:&;fr 

O^S-5e«i-*ffi«^^ h-Mfe-&Y = IQ' il k<D 

Km*®*). t(om±i&i^-r^Lm.^ f**qo t 

[0 0 6 3] Xfy X4_3 Ki3V>t\ vo t»i =p 

0 -qo (0 6 (b) *ffi) o Xf77"4_ 
4ICJ3V>-C, Xt- y X4_2 trafllic, - w i ii6£0 
S^O^Sr^l-^firg^^ h**<&-X = IQi I t 

20 fc-fSo wi t06<O3&*<O®ffSr^1-*fia 

*9 hfrm&Y= IQ* i I *K *-<9«:7< 

ft**fe-TfS:a^i!' h;ws-qi t^-s 0 pi 

po fcli^^-Sfaa-^^ h;WC*t), qi l±. qo 

[0064] ?7"4_5 ICiSV^Tx w l «• x 2 = P 

1 - q i ^Sffi-^o Mb<DXT-y-/4_&, Xt-v-7 

4_7 tc^-r j: 7 \z. m&vWiftzm'o&Lx v *h 

«ftTV>§, 77"4 8 ICfcv^tT, »i OJR^^ 

w final ZWtii-tZx, ZZX, u i iiiEm^±&.T 

Yi l±, Yui = IsubYi , p i*i - qui I <^JK 
•CSff^iXx subYi (±Yi <DUfr&&X$>vX. Z 

[0 0 6 5] 
[»1] 

k> J 

40 

it™ j 

10 0 6 6] - mJi3^C7C^.-^ } ) y KSBtli 

^li, EgM^tOrtSB. Jip*>* = 0£&*o TE. G. 
Gilbert, D. W. Johnson, andS. 
S. Keerthi, "A Fast Proced 
50 ure for Computing the Dis 
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tance Between ComplexObje 
cts in Three—Dimensional 
Space, "IEE Journal of Rob 
otics and Automation, Vo 
1. 4, No. 2, pp. 193-203, 198 
8 J KMU tt&Ak *tt**<W*+*T*=ryXA# 
tS^$ttTV^ 0 H5fc^1\ W^pi , Qi - ^ ^ 

S^WMlTZZbiPfefrlbbtlX^&a v final 

[0 0 6 7] 
[»2] 

max { — v t • x : x€X} , 

max {— v , • y : y e Y > , 

[0 0 6 8] *&»£U Sot, *oftWi±. 
* b;vO«g?&M=Mi +M2 ^Jt^-T^o #CK> 1U5^ 
£'fcfcl8 7 fc#RBL£**fc. H 5 0*7- y 7^4_9 JSA 

"Cli* y final OSS 2 
[0 0 6 9] 
[»3] 

Vfia.l = 5- A-k (Pk " <l\ ) i 

[0 0 7 0] ri»<b. tf^? h;w pi , qi ***f€'*L 

teB^^h^*^- Ipi I *«IHjftCCi*ottffi/<y^-»i 
m= 1 , 2 "Clip i O0lJUttac«l#<Ei-**«. s^m 
-ffflffi/N-^^ti-en^O-p *>. v>i* iX"C & J: v» D ^.y- y 

l t»»fi:LTi.fiMi *JSLTOJ:^KH«rtrv» * 
f„ ( U( w) = J^-Vcr.. =[3u ! 2u 



: I 

teiPF 1 0- 7 4 2 1 5 
22 

*<« 

[0 0 7 1] J£IT-Ct±^ ffif/i^fA^^^V (B- 
s p 1 i n e ) ffill 
[0 0 7 2] 
[&4] 

P.. j (u, w) =DM« B.MIW 



Qi-i. j-i 

Qi. j-i 

Ql41. J-l 
Q 1+2. J — 1 


Qi- i. a 
Qi. 

Qm. J 

Ql.2. J 


Q i - i. j+i 
Qi. i*i 

Q l + J. J*l 
Q 1 j*i 


a,-,. j*t 

Qi. j+* 

Q 1*1. i + 2 

Qi*a. 


- 1/6 
1/2 

- 1/2 
1/6 


1/2 
- 1 
0 

2/3 


-1/2 
1/2 
1/2 
1/6 


1/6 
O 
0 
0 




u 1 ] 






[ w 3 w a 


w 1 ] 







[0 0 7 3] -C^aStLTV^ *><0fc1-* o 5fe-f. ^ 

bfl'vcurve OfclJWffifc* 05©^f 8 "C?fci£> 

tz V final t-TZo H*.pi , Qi «rH«fi-St;*^l) 
rt«<0**««r to iridic 

[0 0 7 4] 

[&5] 

1 0 ] Mk ' (Bl ' Vc.r.e ) «M5 W T =0 



fw (U. W) ■ =UMk * (Br ' M? 



[0 0 7 5] ^jSfe-fu, w*«l»)iSLfeT**i6^.o 



2w j =0 

1 I 

L° J 



[0 0 7 6] 
[»6] 



(13) 
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dt „ 

a u 



23 



-= [6u 2 0 0] DW 
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af, 



aw 



-= [3u J 2u 1 0] D 



3w 2 
2w 

1 

0 



* [0 0 7 7] 
[&7] 

afw 



at, 



a u aw 



D=Mn • (Ba • Vour*. 

[0 0 7 8] t Lt\ 
10 [0 0 7 9] 
[&8] 



) -Ifl 



a f w 
aw 



-=UD 



r 6w 
2 
0 

5 u 

5 w 
i- J 



d f „ (u, w) 

a u 

a fw (u, w) 

du 



a f „ (u, w) 
aw 

a f » (u, w) 
aw 



- f u (u. w) 

- f, lu f w) 



u — ► u + 5 u 
w-*w4- 5 w 

[0 0 8 0] OJ:?i:u f w£S£fLTV*< 0 u , w<D 

Irk* ti±OSfcft*ia7»w^i-J:-5H2ooeitt®©# 
^Koi^T^T&do iR^L^u, wOftui wi 

v curve t "J" o ^ curve 4" v 

curve. i tcHSrLT±KOft-^*l^i:i:^tc^|i)iii- 0 
u, w<50#J$Hi£ LTl3u ui , wi * £ 

&o iR^L^lU, w^£>*#<b:ft£ v curve £t>curve,2 

[0081] ±&<Dm*)i&Lmm-± ^m^^nhtt 

hv curve £ v curve, final £ "t" & o ^ <7)ig£ *9 *I Lfl"^ 

O&^K-fcv*-^ u, wOliri<0^ u , w^lcO$£B£ 
ffii^^l^Ofluf/^y^H^tTLT, Ji 
!£ft-U£|g0iI1-o W±ri*g]5^*-r*:/4_l 0, 4 

v curve, final 

./closest t-T-So ±f2<0JR*i§gO«^ 
li, SI 7 KTF-f-il 



[0 0 8 2] 2 : 3^7cdi!KJ^ fr-^-JjWa 

ffiffi^. -ffe^^G^B^O^) * 1 t<D«it.6 
ICov^TSi^-tSo ZoO^MHOfifi^^ Ml- 
£3**!>&ia*IKi3</>-<\ -3fr**£lfflffi!B3fr, fed-*** 

X, dhffiS^^tC^LTti^-f ^4_1 ~*T ? -/4 
_1 1 oyn-fe^S-miii-f ZtiZX iJSifcWK v 
4 ° closest«r#aJ-f -So 

[0083] (fr-X3 : 2#:x;iM&#, ^o^**di 

•^Sr^-/7'f >ffl^ (B- s p 1 i n e T#i 

E15<0^x ?r4_l~Xf ?^4_8©yo« 
l±, 2^7CCO*-&-C*oT<>, 2^7CtrL^^*»t 
tfiOj iS4t4„ EI5<0^'r 7y4_9<5 rfflB'* 

v^osmj «±, rftj&^f-o&mj nso 

v curve, 

50 K&-i> 0 
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[0 0 8 4] v»* % 200*1-; 
XFihLtz2o<nB- s p 1 i n e 
[0 0 8 5] 
[&9] 



1 



(t) = [V 



1 ] M« = 



Q. 
Q 1*1 



10 
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* [0086] i-f&o Qi liB-Sp 1 ine 

m&(DUm&~£&>Z>o B - s p 1 ine ttHO t \Z X2> 
tikfrt u curve ,ifc©rt»**nfciJV»fc*S; J (t) 
= 0 0, 0^ t si 1 5-Sl7ti-*«Sr*»^o t>5— 
mif&LtzB- s p 1 i n e tt&Kov^T |s|l§tf>^ 

vcurve .ifcfio JBH*0»SI±. 3 ^7cOJgF-&i: 1^ C 

[0 0 8 7] 
[gel 0] 



M. = 



1/6 1/2 -1/2 1/6 

1/2 -1 1/2 O 

1/2 0 1/2 0 

1/6 2/3 1/6 O 



J (t) —- 



dP« (t) 

dt 



= [3t 2 2 t 1 0] Mb 



Qi-i 
Qi 

Qi-i 

Qi42 



V curve 

V curve 

V curve 
Ve 



= 0 



rve J 



[0088] (*-*4 : 2*7c£b»#. 

*3 fcm*IC2*5Gfc*Lfcyn-fe*, £hffiift%#^^ 
1 1 £*--*3 tH]3BltC2^7C^ii:L^*7 p n-fe^«r^»9 

ist^^ia^ wmskv closest *»m-r^o 

[0 0 8 9] -ooaWfr^MW^ttftv^L 
£ 0 ££-Cti> Jtfti:$*t*2oo£!i«Mt:* 1 3^7cW# 
-*£ov*Tfc. ±*i:BM*fc* i •>«JMfc**tfcTA' 
•iSSH** h^*B»BKMLT»KWlc*i6-CV*<» 

[0090] 5fe-f. im «0Bi<O*aff^ 

Sc^^ h >^4r y closest, previous £ LT v final 

7y7_4-7_6tli, mS<DATy 



7_7 tci3v*T> >X<oy u-^oWc&m^? hfrtDW* 

30 2 t-CjPc N ^[H3fc#>fc y closest, previous 
"Jig-to 

[0 0 9 1] — #0»ffcM!i#lHflsO»<fc'Ktt, X-r-^ 
•f 7_4 <07°n -fe* t±dl#MteK;*t LTIH 6 IZfii L/crt 
fltfW, £iffiM^#K*tLTliia7K*L/cS£»rimri* 

Jl-.2>o 
[0 0 9 2] 

*U ff&MT* S^Mffi±K2o<0fl!fe#£«^L-C#f& 

4 v»L3EJ^s ';r;w^-fAtc % -e*tf> 200 

[S®Offi#4lft^] 

[Hi] *»WO**HEIt«JHt!*0-5llt3t$II*a 
-5 n > fcf i - * v ^ r A (Ofl-SEI T * * o 

[12] *§tm<D®itM&m&&$im.<o-$kffi]&m<ozr 
so u-^^ia-cfe^o 
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[0 3] *&wv>®ttm&mmM3SiW.z='>^z.-9 -> 

[04] H8 ! W.<Dffi.tl&7jiLtzffi.tlW?$>Z>o 

[05] fcfig^* hn^ttJTJV^'JXAOPiSBSr^fr 

[0 6] *ft£t::v»?£l h^lSll^e<0 

[0 7] *SS>8Kv>?g2 wSJa^* K ;wlr&¥I8:<D 
-*jfe^s<oifteg0-c*-&o 
[0 8] #&fc1-*©#a*l^fcv>L^i^&J§£-<7>fc 

[flP-^oi&iK] 

i o vs&w&mmnmm 

1 1 ^tttit S8fES^& 

1 2 ftMtt* sim*?*® 

13 mm/*y*mm&.j&.^wt. 

i 4 g^f-IS: 



10 
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* 1 5 SfU wtfig^? h 
16 82 OSiSS^ * h 

1 7 T**lJSg#e 

2 0 ^^NESSIIISfi 
2 1 f- ? A3J32ES 
22 ■< >^-7i-; 

2 3 CPU 

24 0^-7i-^ 

25 ^77-C^?^7'l"< 
2 6 RAM 

2 7 IBtgSSES 

100 3 VfcfjL-^v^xA 
1 0 1 

10 2 SHfc^^gB 
1 0 3 K 
1 0 4 v?* 
1 0 5 

1 1 0 3tttt*l7'<f (MO) 



[0 1] 



[0 2] 



105 




13 



n 


12 

\ 




14 

j 








r — -» 










! i— > 

i i 



15 

1 



10 



L 5 J 



r 



17 



no 



[03] 

21 22 

t-»aa , r~ 

T I _L r 27 



RAM 








^26b 




x-26c 




^-26d 
^-26© 





20 
23 



24 



CPU 





l/F 
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